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SECTION  1 
SCOPE 


l.l  IDENTIFICATION 

Volume  I,  Submarine  OMEGA  Computer  Program  Performance  Specification, 
defines  the  functional  requirements  for  the  Submarine  OMEGA  Computer  Pro- 
gram which  is  used  by  the  AN/ARN-99  OMEGA  Navigation  Set.  The  Navigation 
Set  and  the  OMEGA  program  together  comprise  the  Submarine  OMEGA  Naviga- 
tion System.  The  tape  which  defines  the  computer  program  is  entitled 
AN/BRN  7 Navigation  Program, 

Volume  II,  Submarine  OMEGA  Computer  Program  Design  Specification,  allo- 
cated the  functional  requirements  of  Volume  I to  the  computer  routine  and 
subprogram  level. 

This  volume  describes  the  subprogram  designated  as  Tracking  Filter,  which 
has  the  abbreviation  TF  in  the  program  listing  (Volume  XIII). 


1.2  TRACKING  FILTER  SUBPROGRAM  TASKS  (Figure  1) 

a)  Initialization /Re initialization:  The  procedures  for  initialization  and 
reinitialization  are  used  at  start-up,  when  the  velocity  sources  for 
the  calculations  are  changed;  whenever  a change  in  the  base  station 

is  indicated,  or  whenever  initial  time  or  initial  position  is  inserted. 
The  operations  involved  include  combinations  of:  setting  the  n-counters 
to  zero,  and  resetting  the  phase-difference  variances,  the  phase- 
difference  rate  variances, and  the  cross-variances. 

b)  Time  Updating  of  Variance:  All  Tracking  Filters  are  time  updated  at 
the  end  of  every  OMEGA  burst.  This  includes  the  variance  on  the  phase- 
difference  estimate,  and  if  this  is  too  large  then  the  cross-variance 
is  also  reset.  Similarly  the  variance  on  the  phase-difference  rate 

is  time  updated,  and  if  too  large,  then  again  the  cross-var iance  is 
reset. 

c)  Time  Updating  of  Phase  Rate:  Phase  Rate  is  time  updated  after  the 
variance  time  update  for  each  station- to-base  pair.  Using  station 
coordinates  and  velocity  components,  the  phase  rate  for  the  base  is 
calculated  and  this,  in  turn,  will  be  used  to  correct  the  phase  rate 
on  the  station- to-base  phase-rate  estimate. 

d)  Time  Updating  of  Phase  Estimate:  The  phase  difference  estimate  is 
iterated  once  for  each  station  and  base  station  combination  at  the 
end  of  each  burst  (24  times  in  a 10-second  cycle). 
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TRACKINO  riLTDI 


RESET  PHASE  VARIANCES  AND  THE  N 
COUNTERS  - FORCE  PARTIAL  RESET 


RESET  PHASE  RATE  VARIANCES  AND 
CROSS  CORRELATION  VARIANCES 


ji 

TF  TIME  UPDATE 

PERFORM  TIME  UPDATE  ON  THE 
VARIANCES  FOR  ALL  FILTERS 


it 

COMPUTE  PHI  DOT  DR  FOR  EACH 
STATION  - BASE  STATION 


i 

PERFORM  TIME  UPDATE  ON  THE  PHASE 
ESTIMATE  FOR  ALL  FILTERS 


H 

< MEASUREMENT  UPDATE 


COMPUTE  PHASE  DIFFERENCE  FROM 
THE  BURST  MEASUREMENTS 


FIGURE  1 (Sheet  1) 
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e)  Phase  DiEferenctna:  Using  RAW  H,  which  is  the  three- frequency  burst 
element  from  END  BURST,  determine  whether  to  light  the  SIGNAL  LOSS 
indicator,  and  then  smooth  RAW  H with  previous  data.  Difference  the 
burst  phase  with  that  from  the  station  designated  as  base,  then  add 
their  variances.  Or  if  the  present  station  is  the  base  station  then 
save  for  base  station  phase  rate  updating. 

f)  Measurement  Update:  A measurement  update  occurs  if  the  variance  from 
the  phase  differencing  process  is  less  than  one  square  cycle.  The 
difference  between  the  estimate  of  phase  difference  and  raw  measure- 
ment from  the  OMEGA  PROCESSING  routine  is  used  to  make  the  filter 
adaptive;  the  variances  increase  in  proportion  to  the  amount  of  dis- 
agreement. 

The  correction  term,  0 , must  be  calculated.  The  phase-difference 
rate  variance  is  measurement  updated,  and  then  the  phase-difference 
estimate  is  measurement  updated,  as  well  as  its  variance. 

g)  Increment  n-Counters:  Test  the  variance  on  the  phase-estimate  and 
phase-difference  rate  estimate.  If  within  the  criteria,  set  the 
increment  n-counters. 


Vol  V 


U 


NORT  73-48 


NORTHROP 


Electronics  Division 


r 


t 

SECTION  2 

1 

applicable  documents  i 


V- 

I 


a)  Submarine  OMEGA  Computer  Program  Performance  Specification,  Volume  I 
of  the  Submarine  OMEGA  Computer  Program  Specification. 

Applicable  Sections; 

3.1  Introduction 

3.2  Functional  Description 

3.2.5  Detailed  System  Operations 

3.3  Detailed  Functional  Requirements 

3.3.8  Base  Station  Selection 

3.3.9  Phase  Difference  Function 

3.3.10  Tracking  Filters 

b)  Submarine  OMEGA  Computer  Pro.gram  Design  Specification,  Volume  II  of 
the  Submarine  OMEGA  Computer  Program  Specification. 

3.3  Subprogram  Description  and  Allocation  of  Requirements 


c)  NORT  68-66,  NAP70  User's  Manual,  July  1968. 

d)  NORT  68-115A,  Detailed  Description  of  NDC-1070  Computer  Instructions, 
Revision  A,  February  1970. 

e)  NORT  69-87A,  NDC-1070  Flow  Chart  Program,  User's  Manual. 


NOTE:  The  data  base  for  each  subprogram  is  included  in  the  appropriate 

volume.  V 
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SECTION  3 
REQUIREMENTS 


In  order  to  understand  the  program  description  contained  in  the  following 
pages,  it  is  necessary  that  the  reader  will  have  become  familiar  with  the 
associated  functional  requirements  found  in  Volume  I,  Performance  Specifi- 
cation, and  with  the  subprogram  allocation  found  in  Volume  II,  Design 
Specification. 


3.1  DETAILED  DESCRIPTION 

3.1.1  Reference  Labels  to  Flow  Diagrams 

The  code  used  to  reference  the  particular  block  in  the  flow  diagrams. 

Section  3.2,  is  as  follows:  The  first  number,  preceded  by  a p,  is  the 
page  number  found  in  the  upper  right  corner  of  the  diagrams.  This  will  be 
followed  by  a slash  sign  (/)  to  separate  the  page  number  from  the  block 
designator.  The  designator  will  either  be  a mnemonic  label  (e.g.,  TEST 
SYNC),  a local  label  indicated  by  a dollar  sign  ($),  or  an  integer.  The 
two  types  of  labels  reference  the  particular  information  block,  on  the 
given  page,  to  which  the  label  is  attached.  The  integer  number,  n, 
mear.i  that  the  referenced  block  is  the  nth  block  from  the  top  of  the 
page;  p8/3  would  refer  to  page  8 and  the  third  information  block  down. 

Finally,  the  label  Pl/$2+3  refers  to  page  1,  and  the  3rd  information 
block  after  the  label  $2.  Similarly,  P2/7,8,9  refers  to  Page  2 and 
blocks  7 through  9. 

3.1.2  Overview 

It  is  desirable  to  further  process  the  measurements  from  OMEGA  PRO- 
CESSING in  order  to  develop  more  accurate  and  usable  values.  This  is 
accomplished  in  the  Tracking  Filters.  Successive  phase  measurements  from 
OMEGA  PROCESSING  for  each  transmitting  station  and  each  frequency  are  com- 
bined in  separate  Tracking  Filters.  Since  there  are  8 possible  trans- 
mitting stations  and  3 frequencies  processed  in  the  receiver,  there  are  24 
Tracking  Filters. 

Each  Tracking  Filter  receives  an  input  from  OMEGA  PROCESSING  every  10 
seconds.  This  input  consists  of  a measure  of  phase  and  a computed  vari- 
ance of  this  measurement.  The  Submarine  OMEGA  Navigation  System  uses  a 
hyperbolic  navigation  concept.  Consequently,  each  burst  phase  from  station 
i is  combined  with  the  last  incoming  burst  phase  from  the  station  desig- 
nated as  the  base  station,  and  usually  subscripted  bv  k.  The  result  of  this 
is  a measurement  of  phase  difference.  This  measured  phase  difference 
0.,  (freq)  is  then  compared  (or  weighted  in  a statistical  sense)  with  an 
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estimated  value  of  phase  (freq)  which  the  Tracking  Filter  computes 

based  upon  previous  measurements.  From  this  comparison  a new  estimate  of 
phase  is  computed. 

Henceforth  the  frequency  dependence  of  the  symbols  will  be  dropped  for 
convenience,  so  that  (freq)  will  be  represented  as  0..  • It  is  under- 

stood that  the  operations  involved  apply  to  not  one  but  three  frequencies. 

In  order  to  compare  or  statistically  average  successive  phase  difference 
measurements  spaced  10  seconds  apart  in  time,  it  is  necessary  to  remove 
the  effect  of  the  change  in  phase  due  to  the  submarine  change  in  position. 
This  is  referred  to  as  rate-aiding.  Velocity  information  is  obtained 
from  a velocity  source  external  to  the  OMEGA  receiver  (E.M.  Log  Repeater 
or  manual  insert).  The  velocity  inputs  to  the  Tracking  Filter  consist  of 
the  V2  and  components  of  the  raw  velocity  as  computed  by  the  velocity 
processing  equation.  OMEGA  velocity  corrections  are  not  used  in  Tracking 
Filters.  The  Tracking  Filter  then  computes  the  component  of  velocity  along 
the  direction  from  submarine  to  transmitting  station,  then  to  the  base 
station,  and  then  converts  to  an  equivalent  dead  reckoning  phase  rate, 

0OR.  This  phase  rate  is  then  used  to  update  the  Tracking  Filter  phase- 
difference  estimate  ^0 . 


Besides  estimating  phase  differences,  the  Tracking  Filter  also  estimates 
phase-difference  rate  error, A0.  This  is  the  error  in  phase  rate  as  com- 
puted from  the  velocity  sources.  The  estimated  phase-difference  rate 
error  is  used  to  correct  the  computed  phase-difference  rate  0pj^  in  the 
time  update  of  the  estimate. 


In  addition  to  computing  0 
following  variances: 

and 

a‘0, 

the 

a) 

a2 

00 

, the 

variance  of 

the 

error 

in 

b) 

‘’^00 

, the 

variance  of 

the 

error 

in 

error 

c) 

, the 

cross-var iance 

of  errors 

It  is  the  computation  of  these  variances  along  with  (T  ^ from  burst  ^ 
measurements  that  allows  the  filter  to  statistically  average  0£  and  0i^i^ 
and  obtain  better  estimates  of  and  A0j^j^.  The  three  variances  listed 
above  are  updated  and  recomputed  at  every  phase  measurement. 

/\  2 

The  outputs  of  the  Tracking  Filters  are  0,  cr00  (station  and  base  sub- 
scripts omitted)  for  each  station-base  or  base-base  pair.  These  outputs 
are  the  inputs  to  the  Combinational  Filter.  The  Combinational  Filter  com- 
bines the  outputs  of  the  Tracking  Filters  to  obtain  position  estimates. 
When  cr  ^00  has  reached  a value  of  less  than  3 cec^  and  cr '^00  is  less  than 
(0.03  cec/sec)^  for  three  consecutive  Burst  Filter  measurements,  the  phase 
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estimate  is  considered  accurate  enough  to  be  used  by  the  Combinational 
Filter.  A counter  (called  the  n counter)  is  used  as  a flag  to  tell  the 
Combinational  Filter  when  to  read  the  Tracking  Filter  outputs. 

With  every  phase  difference  measurement  the  counter  is  incremented  if 
(T  ^00  and  (T  ^00  are  both  less  than  their  respective  limits,  otherwise  the 
counter  is  reset  to  zero.  When  the  counter  reaches  three,  the  Tracking 
filter  is  ready  to  be  read.  The  Combinational  Filter  will  then  read  the 
0 and  0-200  from  the  Tracking  Filter.  Until  the  Tracking  Filter  outputs 
are  read  the  Tracking  Filter  continues  to  operate  in  a normal  manner. 

When  the  outputs  are  read,  the  n counter  is  reset  to  zero  and  the  Tracking 
Filter  is  reset.  It  is  desirable  for  each  reading  from  a given  Tracking 
Filter  to  be  statistically  independent  from  the  others.  For  this  reason, 
the  Tracking  Filter  variances  are  reset  to  their  initial  values  after 
being  read  by  the  Combinational  Filter,  These  values  assure  independence 
of  Tracking  Filter  outputs. 

The  statistical  derivation  of  the  Tracking  Filter  equations  is  given  in 
Appendix  A,  Volume  I. 


3.1.3  Description  of  Flow  Diagrams 

The  following  description  is  by  the  task  sequence  outlined  in  1.2. 

The  Submarine  OMEGA  Computer  Program  Functional  Requirements  were  defined 
in  Volume  I,  Performance  Specification,  and  allocated  to  Subprograms  in 
Volume  II,  Design  Specification.  The  Tracking  Filter  Subprogram  has  com- 
bined portions  of  these  requirements.  Those  affected  are  summarized  here 


Paragraph  in  this  section  Functional  Requirement 

e 1)  3,3.3  Base  Station  Selection 

item  3. 3. 8. 3. 1-c 
3.3.8.3.2-b 

e 2)  3.3.9  Phase  Difference  Function 

All  others  3.3,10  Trackirtg  Filter  Requirement 

a)  Initialization /Re  initialization 
pl/Tracking  Filter 
to 

p2/TF  Time  Update 

I 

f 

i 

I 

I 


- i 
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1)  The 

a . 

b. 

c . 


d. 


e . 

2)  The 


a. 


b. 


c . 


d. 


NOTE: 


Initialization/Reinitialization  procedures  are  used: 

At  start-up 

When  the  velocity  sources  for  the  calculations  are  changed 

When  the  Combinational  (Kalman)  Filter  uses  a Tracking  Filter 
output  (See  note  for  Ic,  below) 

Whenever  a change  in  the  base  station  is  indicated 
Whenever  initial  time  or  initial  position  is  entered, 
procedures  for  the  above  are  as  follows: 

Set  all  n-counters  to  zero 
Set  0-  4)4)  = Y2 

Set  4)^=  0 

Set  <r  = (0.006  7r)2 

For  la;  Id;  le,  reset  all  tracking  filters  by  2a  through  2d. 

For  lb,  reset  all  tracking  filters  by  2c  and  2d, 

For  Ic,  reset  only  the  selected  filter,  using  2a  through  2d. 

For  Ic,  the  Combinational  Filter  resets  only  the  selected  filter 
and  effectively  accomplishes  2a  through  2d,  but  does  not  use  the 
Tracking  Filter  reinitialization  procedures. 


b)  Time  Updating  of  Variance 
p2/TF  Time  Update 
to 

P3/$3  + 5 

All  Tracking  Filter.*?  are  time  updated  at  the  end  of  every  OMEGA  burst. 
The  following  equations  are  computed  in  the  order  indicated. 


2 


Test;  is  <r  (k)  >1  (cycle) 


Vol  V 


9 


NORT  73-48 


NORTHROP 


Electronics  Division 


2 2 
Yes.  Then  set  ff  (k)  = 1 (cycle) 


go  to  (2) 


No.  Then  (k)  = (r^^Ck-l)  + (k-1)  ^tj^ 


2)  (k)  =0-/^  (k-1)  + 

Test:  is  . («  > ^ 


2 1 

Yes.  Then  set  <rj>i  = 


> 

and  continue. 

No.  Then  continue, 
c ) Time  Update  of  Phase  Rate 
p4/$l  to  p6/$6 


2T^ 

I (k)  = 


W4  (k) 


Processed  after  variance  update  for  each  station  and  base-station  pair. 

1)  Station  coordinates;  earth  fixed  to  local  level  coordinates.  Obtain 
for  station  and  base. 


SL 


'2i 


f=l 


’^2f  ^fi 


Vo  I V 
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SL 


3i 


3 

z 

f=l 


"fi 


1 = 1. 


. 8 (station) 


r . . 

ij 


Element  in  the  row  and  column  of  the  matrix 


2)  (S 


DR 


from  which  vehicle  position  is  computed. 
Determination;  obtain  (station)  and  (base) 


DR. , 
11 


SL3?  + SL 


2i 


1/2 


Since  the  filters  are  tracking  an  angle  that  represents  the  phase 
of  station  i at  time  t minus  the  phase  of  the  base  station  at  some 
earlier  time,  it  is  necessary  to  make  the  following  correction  for 


arrival  at  the  final  value  of  0 for  each  Tracking  Filter; 

UK 


where 


i = station  number 
j = frequency 
k = base  station  number 
t = time 

t'  = time  delay  between  base  station  burst  and  station 

i burst  for  this  frequency  (if  i=k  then  t-t=  10  sec) 


For  computational  purposes  it  would  be  adequate  to  set  t ’ = 0 in 
all  cases . 


d)  Time  Update  of  Phase  Estimate 
p6/$2  to  p6/Measurement  Update 

The  phase  difference  estimate  is  iterated  once  for  each  station  and 
base  station  combination  at  the  end  of  each  burst  (24  times  in  a 10 
second  cycle). 
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0 (k) 


0 (k-1)  + At 

u 


— o 
\i  '^DR 


(k)  +A0  (k-1) 


where  = time  period  since  last  update. 

If  Atj^  is  interval  of  previous  burst  then 

At  • At  +0.4  sec. 
u b 

e)  Phase  Differencing 

p6/Measurement  Update  to  pl0/$21  + 1 

1)  For  station  i,  obtain  RH^  from  OMEGA  Processing 
mi  1 ml  / mi  J 

Perform  a simple  smoothing  operation  on  resultant 


SRH.  = SRH,  +0.1  (RH.  - SRH . ) 

1 i 1 1 

If  <0.0078125  then  set  SIG  LOSS  marker  and  continue  normal 

operation,  otherwise  continue, 

2)  Phase  Difference  Calculation:  The  following  procedures,  though 
indicated  for  one  input  only,  are  done  three  times  per  each  burst 
period;  24  per  10-second  OMEGA  cycle. 

Determine  station  and  frequency  of  input.  Is  input  phase  measure- 
ment from  base  station?  (check  BASE) 


No.  Then  difference  input  phase  measurement  0g  with  last  stored 

base  station  phase  value  0^,,  where  0£  represent  the  0 value  from  station 

i on  the  associated  frequency;  from  burst  processing.*" 


»ab  ■ “a  - »b 


Then  combine  the  associated  variances  as  indicated. 


ab 


where  cr  represents 
burst  processing. 


station  i on  associated  frequency;  from 
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I 

I 

i 

( 

I 


Yes.  Then  difference  input  base  station  measurement  with  last 
stored  base  station  phase  value.  Combine  the  variances  as  indi- 
cated. 

= 0,  (input)  - d,  (stored) 
bb  b b 

^hh  = <r2^(stored) 

Then  replace  reference  base  station  phase  vabie  and  variance  with 
input  values. 

f ) Measurement  Update 

pll/1  to  3 

A measurement  update  is  permitted  to  occur  if  the  variance  from  OMEGA 
Processing  is  less  than  one  square  cycle.  The  difference  between  the 
estimate  of  phase  difference,  and  the  raw  measurement,  used 

to  make  the  filter  adaptive;  the  variances  increase  in  proportion  to 
the  amount  of  disagreement^  Since  is  a value  averaged  over  the 

time  interval  At^  while  0 is  updated  by  rate  aiding  to  the  end  of 
the  time  interval,  ^ is  adjusted  to  make  it  correspond  to  near  the 
middle  of  the  interval.  This  explains  the  correction  term  in  the  equa- 
tion for  the  angular  diffe:rence  0, 

1)  Angular  Difference  Correction 


0 = 


0 


m 


✓V. 

A0 


(0.425) 


(The  subscripts  will  be  dropped  for  this  subsection  with  the  under- 
standing that  the  equations  will  be  computed  for  the  particular 
station-base -frequency  pairs  for  which  0^j^  is  available  in  this  time 

slot .) 

Computational  parameters 

At  = 10  seconds 

m 

C = cos  0 
S = sin  0 


I 


2)  Phase  Rate  Uodatp 


L 


Vol  V 


2 . 


At  + a-^ 

^ m ik 


NOTE:  and  the  2nd  term  of  (k+1)  are  computed  by  the  L 

ALPHA  Subroutine,  page  15. 


2.. 

<j>4. 


2 . ^ 

T 4^At 


gJ.-  ^ ^3  j 

[S  + " cj  TJa  2^;  sj2 

^TfT  - 


L J 

(If  > 2 then  set  1*2;  computed  in  the  L ALPHA 
Subroutine) 


Ai  (k+1)  = A0(k)  + ^ tan’^ 

m 


6<t>  At^  S 


L,  + O'  <#>♦  At  C 
-3  m 


TEST: 


IS 


IA0  > 4 dec's/ 


sec 


Yes.  Then  setA’^  = 0 and  continue 
No.  Then  continue 


pll/4  to  8 


-2.  . 


.2..  h I 2 2 

or  xj  /•t,\  ^ 


‘>-<^^(k+l)  = <r-^^  (k)  ^^1  <r-^^  (k)  +0-^^ 

in  I 

If  '^^^0  ^ (r2^{k+l)  = 1 


21-2  *^^4  (>^) 

At 


m 


2tt 


00 


2 tt 


p12/1,2 


NOTE:  L and  the  2nd  term  of  the  .. 

4 ..u  T “P  (R+1)  equation  are  comouteH 

in  the  L ALPHA  subroutine,  page  15.  computed 


1 / 2 ? 7 


2 / 2 

Ik  00 


00 


(If  Lj  > 1 then  set  Lj^  «=  1) 
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3)  Update  of  Phase  Estimates 
pl2/3 


A 2 „ 

^ A -.O'  aa  S 

0 (k+1)  = 0 (k)  + tan'^ 


n-2  2 

i,^+  0-  C 


4)  Cross  Variance  Update 
pl2/4 


2 

N r 2 . „ , ^2  2 „ J ^2  it 

!>  or  4>4,  (k)  - — a 4,4,(k)  + — 

L m J m 


5)  Update  of  Variance  of  the  Phase-Difference  Estimate 
pl2/$3  to  P13/$5 


4,4,(k)  + L 2 


Ik 


If  (1-L^)2  0-  ,(,<j>(fcH)  ;;>!  (cycle)^  then  set  o' (k+1) 
g)  Increment  n-Counters 
pl3/$5+l  to  pl4/$8 


= 1 


Test 


Is  <r^^<j,<(3.  cec)^  and  <r^^^(0.03  cec)^ 


Yes:  then  increment  n-counter  by  +1 
No:  then  reset  n-counter  to  zero 


when  Measurement  Update  iterations  have  been  completed  and  n-counters 
have  been  incremented,  then  exit. 


Vol  V 


15 


NORT  73-48 


NORTHROP 


Electronics  Division 


Additional  Note:  A Tracking  Filter  Functional  Requirement  is  the  Integral 
Lane  Count  Check  (found  in  paragraph  3.3.10  (c)  4, Volume  1)  which  requires 
that  periodically  the  Tracking  Filter  will  compare  its  phase  difference 
estimate  (in  cec's)  with  the  phase  difference  estimate  from  the  propaga- 
tion prediction  routine. 

This  requirement  has  been  allocated  to  PROPAGATION  PREDICTION.  This  means 
that  it  cannot  be  represented  in  the  Tracking  Filter  flow  diagram,  since 
the  time  of  occurrence  is  not  precisely  known. 


3.1.4  Description  of  Subroutines  Used  by  the  Tracking  Filter  Subprogram 
a)  L ALPHA  (page  15) 

This  subroutine  accepts  three  arguments  (0,  B,  and  A)  and  returns 
ALPHA  and  L. 

, _ (A  cos  Q + B)  B 

^ “ 2 2 
(A  + B cos  0)  + (B  Sin  6) 

ALPHA  - TAN*^  ( ^ -q  ) 

\ A + B cos  0 / 


3.2  FLOW  CHARTS 

The  Tracking  Filter  Subprogram  flow  charts  are  presented  in  the  following 
pages . 


Vol  V 
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TRACKING  riLTCR 

this  program  is  cxccuteo  at  The  eno  op  Every  station  burst. 

IT  smoothes  the  computed  phase  and  provides  outputs  to  KALMAN. 

for  notational  purposes  the  symbols  listed  below  hill  be  used 

P6  • BURST  PHASE  MEASUREMENT 

SB  - BURST  phase  measurement  VARIANCE 

P • TRACKING  FILTER  PHASE  ESTIMATE 

PR  - tracking  filter  phase  rate  estimate 

PROR  • PHASE  RATE  DUE  TO  CRAFT  MOTION  TOWARDS  THE  STATION 
0TB  - DELTA  T BURST 

OT  - TIME  BETWEEN  TRACKING  FILTER  TIME  UPDATES 

S - TRACKING  filter  PHASE  ESTIMATE  VARIANCE 

SR  • TRACKING  filter  PHASE  RATE  ESTIMATE  VARIANCE 

SC  - CROSS  CORRELATION  OF  PHASE  AND  PHASE  RATE  VARIANCE 

C • CYCLE 

N - TRACKING  FILTER  N COUNTERS 

DTM  -TIME  BETWEEN  TRACKING  FILTER  MEASUREMENTS  1 10  SECONDS) 


NORTHROP 


Electronics  Division 


PAGC  0002 


RESET  THE  ‘RESET  TE  MARKER' 

load  registers  mith  addresses  or 
S.  SR.  sc  AND  N 
SET  UP  counter  to  CYCLE  ALL 
TRACKING  FILTERS  (3  PER  STATION! 


HAS  the  NAV  MOOC 
fHANGEO  SINCE  LAST  ENTRY? 


RESET  VARIANCES  ASSOCIATED  WITH 
PHASE  RATE  SINCE  VELOCITY  CHANGE 
MAY  MAKE  PREVIOUS  ESTIMATES 
INVALID 

SAVE  NEU  NAV  MODE 

OPEN  SR  UP  TO  (.003  C/SEC) ‘‘Z 

SET  SC  • 0 (ALL  FILTERS) 


• TRACKING  filter  TIME  UPDATE 

• UPDATE  ALL  TRACKING  FILTERS 

• TO  TIME  or  END  BURST 


i TF  TIME  UPDATE 

COMPUTE  UPDATE  DELTA  T (DT) 

DT  » DTB  ♦ -R  SEC  SCALED  PI 


ill 


NORT  73-48 


nur 
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PACC  0003 


V 

SET  SINEW!  - I C»*2 
SET  SCINEW)  - SC/2 


1 

1_« 

TIME  UPDATE  SC 
SCINEW)  - SC  * SHOT 

scaled  I/2PI  C»»2/SEC 


)^ 

) M 

TIME  UPDATE  SR 


SRINEW)  - SR  ♦ R**2 

SCALED  1/2P1»»2  C»»2/S£C»«2 
WHERE  R - .000012  IC/SEC)»«2 


SET  SRINEW)  • (.225  C/SCC>**2 
SET  SCINEW)  - SC/2 


)^ 

V CP 

SAVE  NEW  SR 


TE  TIME  UPOATCSI 
0002 

1 

• START  TIME  UPDATE  OF  PHASE  ESTIMATE 

11 

LOAD  REGISTERS  WITH 

ADDRESSES  OF  TEMP,  STATION  i 

VECTOR.  RU.  PRDR,  PR  AND  P 1 

SET  UP  COUNTER  TO  CYCLE  EACH 

STATION  ] 

SET  UP  COUNTER  FOR  3 FREQ I 
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PACE  OOOS 
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PACC  ooos 


THE  BASE  station  PROR  TOR  TIME 
(NOW)  HAS  NOT  BEEN  COMPUTED  YET 

the  first  entry  in  the  table  is 

FOR  THE  PREVIOUS  BURST  SO  DECRE- 
MENT STATION  - BASE  NUMBER  BY  I 
I TO  CORRECT  FOR  THIS 


ji 

SIO 

AOO  8 TO  THE  STATION  - BASE 
NUMBER  TO  PUT  IT  IN  THE  RANGE  OF 
I TO  8 ktHERE  8 - 10  SEC  AND 
IMPLIES  this  is  THE  BASE  STATION 


SUB  ALWAYS  PHASE  DIFFERENCE 


FORM  PROR  FOR  THIS  SET  OF  THREE 
tracking  filters  (3  FREQ)  WHERE 
PRDR  - PROR  (THIS  STATION) 

MINUS  PROR  (BASE) 


NORTHROP 
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PAGC  0006 


• USE  BURST  phase  AMO  VARIANCE  TO  UPDATE 

• THE  TRACKING  FILTERS  OF  THE  THREE  STATIONS 

1 

MEASUREMENT  UPDATE 

USE  STATION  COUNTER  (-  NUMBER 
OF  STATION  that  JUST  TRANSMITTED 
10. ai  AND  FREQ  NUMBER  TO  GET  THE 
NUMBER  OF  THE  STATION  THAT  JUST 
TRANSMITTEO  THIS  FREQUENCT 
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P*CC  0007 

ThC  LIST  or  AVAILABLE 

>-« 

$9 

t * V 1 r *w  W # ^ M V M 1 W 

--.^STATIONS?  ^ ^ 

OOIH 

vkT^ 

IS  THIS  FRCQUENCT  11.37 

>-^ 

SIS 

Electronics  Division 


r>Ace 


1 

' se«4 

COMPUTE  H BURST 

H BURSr(Neu)  • H BURST 

* . MIH  RAM  - H BURSTI 

scaled  B3 


SIS 


READ  BURST  PHASE  P8  FOR  THIS 
STATION  AND  FREQUENCY 


SUB  ALMAYS  PHASE  DIFFERENCE 


SUBTRACT  LAST  BURST  PHASE  FROM 
BASE  STATION  FOR  THIS  FREQ  FROM 
PS 


i SIO 

SAVE  NEH  PB  FOR  THIS  FILTER 

READ  BURST  PHASE  VARIANCE  SB  FOR 
THIS  STATION  AND  FREQUENCY 
COMPUTE  SB  ♦ (.005  CM»2 
NOTE  - SB  ♦ (.005  CM»2  MILL  BE 
A NEGATIVE  NUMBER  IF  IT 
EXCEEDS  I C**2  MHICH  IS 
USCO  AS  A MARKER  INDICA- 
TING AN  INVALID  MEASURE- 
MENT 


OOOB 
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PACC  0010 


RCAO  THC  tracking  riLTCR  START 
marker  »*4ICh  is  set  true  by  t»c 

BASE  STATION  SELECTION  ROUTITC 
AT TER  ENOUGH  TIME  HAS  ELAPSED  TO 
COLLECT  BASE  STATION  DATA  SO 
THAT  THE  MEASUREMENTS  ARE  VALID 


IS  Tr«  TRACKING 

^TER  start  marker  true? 


IS  THIS  PHASE 

OIEFERENCE  TRACKING? 
(NO  MEASURETCNTI 


• SUBMARINE  always  PHASE  OIFEERCNCE 


READ  SB  FOR  THIS  FILTER 
NEGATIVE  SB  IS  A MARKER  INDICA- 
TING NO  MEASUREMENT 


• UPDATE  PHASE  RATE  ESTIMATE  CPR> 
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0011 


27 


NORT  73-A8 


Electronics  Division 


P*GC  0011 


SET  S • 1 

5 

ss 

SAVE  SrNEMI 

MEASUREMENT  UPDATE  IS  NOW  COMPLETE 
NOW  CONSIDER  IF  VARIANCES  ARE 
sufficiently  small  to  IKCICATE 
GOOD  TRACKir<IG  TO  KALMAN 


IS  S LESS  THAN  1.003  Cl ••27 


IS  SR  LESS  THAN  (.0009  C/S)^^27 


TRACKING  IS  GOOD 
INCREMENT  N COUNTER  BY  I 
(WHEN  N-3  KALMAN  CAN  TAKE  DATA! 


DECREMENT  N BY  I SO  THAT  IT  WILL 
NEVER  EXCEED  7 THIS  IS  FOR  THE 
CONVENIENCE  OF  THE  C/ I PROGRAM 
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P*GC  00 IS 


> L ALPHA  suenouTirc 

» 

• THIS  routine  hill  accept  3 ARCLPCNTS  (TICTA,  B AND  Al 

• AND  RETURN  ALPHA  ANO  L 


i L ALPHA 

SINIALPHA)  > B • SINITHETAI 
COSIALPHAI  - A « B • COSITHCTA) 
numerator  op  L • (A  • COSITICTAt 
* B)  • B 

DENOMINATOR  OF  L - 
(B  • COSITHETAI  * Al**2 
* (B  • SIN(THETA))**S 


compute  absolute  value  of 

NUMERATOR 


JILL  THE  DIVIDE  OVERFLOW? 


NUMERATOR  / ABSOLUTE  NUTCRA- 
TOR  I-  ♦!  OR  -n 


L • NUMERATOR  / DENOMINATOR 
SCALED  I 


ALPHA  - ATAN  SIN/COS  SCALED  PI 
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3.3 


COMPUTER  SUBPROGRAM  ENVIRONMENT 


3.3.1  Tracking  Filter  Tables 


a)  Frequency  Ratio  TaM.e.  The  Frequency  Ratio  Table  is  used  to  convert 
PHI  DOT  DR  from  13.6  cycles  per  second  to  the  appropriate  frequency. 

The  table  has  three  entries  that  consist  of  the  ratio  of  the  selected 
frequency  to  the  13.6  frequency.  The  table  has  the  usual  order  of  10.2, 
13.6  and  11-1/3.  The  official  label  of  this  table  is  TF  LAMBDA  CONSTANT 
TABLE. 

b)  Station  Location.  This  table  contains  the  location  of  all  existing 
OMEGA  transmitting  stations.  Each  location  is  specified  as  a three- 
element  geocentric  position  vector.  The  first  entry  is  for  station  A, 
The  table  is  defined  in  detail  in  the  listing.  The  official  name  of 
this  table  is  STATION  VECTOR  TABLE. 


3.3.2  Temporary  Storage 

The  Tracking  Filter  program  requires  six  words  of  temporary  storage  in 
addition  to  that  storage  used  in  the  R15  pushdown  stack. 

3.3.3  Input/Output  Formats 
Not  applicable. 

3.3.4  Required  System  Library  Subroutines 


Subroutine 

Functional 
Description 
(Section  3.1.3) 

Flow 

Diagram 

Subprogram  Design 
Document 
(by  Volume) 

ATAN 

f-2 

L ALPHA  Sub 

XII  Common  Subroutines 

MATRIX  3D 

c- 1 

1 

P4/$l+l 

XII  Common  Subroutines 

SIN-COS 

f-1 

L ALPHA 

XII  Common  Subroutines 

(Page  15) 

SQRT 

c-2 

p4/$l+4 

XII  Common  Subroutines 

1 

( 

N 

( 


i 


1 


